/**
 * @brief   GDISP Graphics Driver subsystem low level driver source for the ILI9320 display.
 *
 * @addtogroup GDISP
 * @{
 */

#include "gdisp_lld_mdwr.h"
#include "gdisp_lld_hal.h"
#include "stm32f10x_it.h"

/*===========================================================================*/
/* Driver local definitions.                                                 */
/*===========================================================================*/

/* This controller is only ever used with a 240 x 320 display */
#define GDISP_SCREEN_WIDTH		240
#define GDISP_SCREEN_HEIGHT		320

#define GDISP_INITIAL_CONTRAST	50
#define GDISP_INITIAL_BACKLIGHT	100

/*===========================================================================*/
/* Driver exported variables.                                                */
/*===========================================================================*/

/*===========================================================================*/
/* Driver local variables.                                                   */
/*===========================================================================*/

struct GDISP_  GDISP;
/*===========================================================================*/
/* Driver local functions.                                                   */
/*===========================================================================*/

static void lld_lcdDelay(uint16_t nCount);
static void lld_lcdWriteIndex(uint16_t index);
static void lld_lcdWriteData(uint16_t data);
static void lld_lcdWriteReg(uint16_t lcdReg, uint16_t lcdRegValue);
static uint16_t lld_lcdReadData(void);
static uint16_t lld_lcdReadReg(uint16_t lcdReg);
static void lld_lcdWriteStreamStop(void);
static void lld_lcdReadStreamStart(void);
static void lld_lcdReadStreamStop(void);
static void lld_lcdReadStream(uint16_t *buffer, uint16_t size);
static void lld_lcdSetCursor(uint16_t x, uint16_t y) ;
static void lld_lcdResetViewPort(void);

static void lld_lcdDelay(uint16_t nCount)
{
	volatile uint16_t countTimer = 0;
	startTimer_1ms();
	while(nCount >= countTimer)
	{
		countTimer = endTimer_1ms();
	}
}

static void lld_lcdWriteIndex(uint16_t index)
{
	gdisp_lld_write_index(index);
}

static void lld_lcdWriteData(uint16_t data)
{
	gdisp_lld_write_data(data);
}

static void lld_lcdWriteReg(uint16_t lcdReg, uint16_t lcdRegValue)
{
	gdisp_lld_write_index(lcdReg);
	gdisp_lld_write_data(lcdRegValue);
}

static uint16_t lld_lcdReadData(void)
{
	return gdisp_lld_read_data();
}


static uint16_t lld_lcdReadReg(uint16_t lcdReg)
{
    volatile uint16_t dummy;

    gdisp_lld_write_index(lcdReg);
    dummy = lld_lcdReadData();
    (void)dummy;

    return lld_lcdReadData();
}

void lld_lcdWriteStreamStart(void)
{
	lld_lcdWriteIndex(LCD_WRITE_DATA_TO_GRAM_R22);
}
	
static void lld_lcdWriteStreamStop(void)
{
}

void lld_lcdWriteStream(uint16_t *buffer, uint16_t size)
{
	uint16_t i;

	for(i = 0; i < size; i++)
		lld_lcdWriteData(buffer[i]);
}

static void lld_lcdReadStreamStart(void)
{
	lld_lcdWriteIndex(LCD_WRITE_DATA_TO_GRAM_R22);
}

static void lld_lcdReadStreamStop(void)
{
}

/*===========================================================================*/

static void lld_lcdReadStream(uint16_t *buffer, uint16_t size)
{
	uint16_t i;
	volatile uint16_t dummy;

	dummy = lld_lcdReadData();
	(void)dummy;

	for(i = 0; i < size; i++)
		buffer[i] = lld_lcdReadData();
}

bool gdisp_lld_init(void)
{
	uint32_t DISPLAY_CODE;

	/* Initialise your display */
	gdisp_lld_init_board();

	/* Hardware reset */
	/*gdisp_lld_reset_pin(TRUE);
	lld_lcdDelay(2000);
	gdisp_lld_reset_pin(FALSE);
	lld_lcdDelay(2000);*/

	DISPLAY_CODE = lld_lcdReadReg(0);
    lld_lcdWriteReg(LCD_START_OSCILLATION_R00, 0x0001); /* Start Int. osc */
    lld_lcdDelay(100);

    lld_lcdWriteReg(LCD_DRIVER_OUTPUT_CONTROL_R01, 0x0100); /* Set SS bit (shift direction of outputs is from S720 to S1) */
    lld_lcdWriteReg(LCD_DRIVING_WAVE_CONTROL_R02, 0x0700); /* Select  the line inversion */
    lld_lcdWriteReg(LCD_ENTRY_MODE_R03, 0x1038); /* Entry mode(Horizontal : increment,Vertical : increment, AM=1) */
    lld_lcdWriteReg(LCD_RESIZING_CONTROL_REGISTER_R04, 0x0000); /* Resize control(No resizing) */
    lld_lcdWriteReg(LCD_DISPLAY_CONTROL2_R08, 0x0202); /* Front and back porch 2 lines */
    lld_lcdWriteReg(LCD_DISPLAY_CONTROL3_R09, 0x0000); /* Select normal scan */
    lld_lcdWriteReg(LCD_DISPLAY_CONTROL4_R0A, 0x0000); /* Display control 4 */
    lld_lcdWriteReg(LCD_RGB_DISPLAY_INTERFACE_CONTROL1_R0C, 0x0000); /* System interface(1 transfer /pixel), internal sys clock */
    lld_lcdWriteReg(LCD_FRAME_MARKER_POSITION_R0D, 0x0000); /* Frame marker position */
    lld_lcdWriteReg(LCD_RGB_DISPLAY_INTERFACE_CONTROL2_R0F, 0x0000); /* Selects clk, enable and sync signal polarity */
    lld_lcdWriteReg(LCD_POWER_CONTROL1_R10, 0x0000);
    lld_lcdWriteReg(LCD_POWER_CONTROL2_R11, 0x0000); /* Power control 2 reference voltages = 1:1 */
    lld_lcdWriteReg(LCD_POWER_CONTROL3_R12, 0x0000); /* Power control 3 VRH */
    lld_lcdWriteReg(LCD_POWER_CONTROL4_R13, 0x0000); /* Power control 4 VCOM amplitude */
    lld_lcdDelay(100);

    lld_lcdWriteReg(LCD_POWER_CONTROL1_R10, 0x17B0); /* Power control 1 BT,AP */
    lld_lcdWriteReg(LCD_POWER_CONTROL2_R11, 0x0137); /* Power control 2 DC,VC */
    lld_lcdDelay(100);

    lld_lcdWriteReg(LCD_POWER_CONTROL3_R12, 0x0139); /* Power control 3 VRH */
    lld_lcdDelay(100);

    lld_lcdWriteReg(LCD_POWER_CONTROL4_R13, 0x1d00); /* Power control 4 vcom amplitude */
    lld_lcdWriteReg(LCD_POWER_CONTROL7_R29, 0x0011); /* Power control 7 VCOMH */
    lld_lcdDelay(100);

    lld_lcdWriteReg(LCD_GAMMA_CONTROL_R30, 0x0007);
    lld_lcdWriteReg(LCD_GAMMA_CONTROL_R31, 0x0403);
    lld_lcdWriteReg(LCD_GAMMA_CONTROL_R32, 0x0404);
    lld_lcdWriteReg(LCD_GAMMA_CONTROL_R35, 0x0002);
    lld_lcdWriteReg(LCD_GAMMA_CONTROL_R36, 0x0707);
    lld_lcdWriteReg(LCD_GAMMA_CONTROL_R37, 0x0606);
    lld_lcdWriteReg(LCD_GAMMA_CONTROL_R38, 0x0106);
    lld_lcdWriteReg(LCD_GAMMA_CONTROL_R39, 0x0007);
    lld_lcdWriteReg(LCD_GAMMA_CONTROL_R3C, 0x0700);
    lld_lcdWriteReg(LCD_GAMMA_CONTROL_R3D, 0x0707);
    lld_lcdWriteReg(LCD_GRAM_HORIZONTAL_R20, 0x0000); /* Starting Horizontal GRAM Address */
    lld_lcdWriteReg(LCD_VERTICAL_ADDRESS_SET_R21, 0x0000); /* Starting Vertical GRAM Address */
    lld_lcdWriteReg(LCD_HORIZONTAL_GRAM_STRART_R50, 0x0000); /* Horizontal GRAM Start Position */
    lld_lcdWriteReg(LCD_HORIZONTAL_GRAM_END_R51, 0x00EF); /* Horizontal GRAM end Position */
    lld_lcdWriteReg(LCD_VERTICAL_GRAM_STRART_R52, 0x0000); /* Vertical GRAM Start Position */
    lld_lcdWriteReg(LCD_VERTICAL_GRAM_END_R53, 0x013F); /* Vertical GRAM end Position */

    switch (DISPLAY_CODE)
	{
		case 0x9320:
        	lld_lcdWriteReg(LCD_GATE_SCAN_CONTROL_R60, 0x2700); /* Starts scanning from G1, and 320 drive lines */
        	break;
		case 0x1320:
			lld_lcdWriteReg(LCD_GATE_SCAN_CONTROL_R60, 0x2700); /* Starts scanning from G1, and 320 drive lines */
			break;
      	case 0x9325:
     		lld_lcdWriteReg(LCD_GATE_SCAN_CONTROL_R60, 0xA700); /* Starts scanning from G1, and 320 drive lines */
			break;
	}

    lld_lcdWriteReg(LCD_GATE_SCAN_CONTROL_R61, 0x0001); /* Fixed base display */
    lld_lcdWriteReg(LCD_GATE_SCAN_CONTROL_R6A, 0x0000); /* No scroll */
    lld_lcdWriteReg(LCD_PANEL_INTERFACE_CONTROL1_R90, 0x0010); /* Set Clocks/Line =16, Internal Operation Clock Frequency=fosc/1 */
    lld_lcdWriteReg(LCD_PANEL_INTERFACE_CONTROL2_R92, 0x0000); /* Set gate output non-overlap period=0 */
    lld_lcdWriteReg(LCD_PANEL_INTERFACE_CONTROL3_R93, 0x0003); /* Set Source Output Position=3 */
    lld_lcdWriteReg(LCD_PANEL_INTERFACE_CONTROL4_R95, 0x0110); /* RGB interface(Clocks per line period=16 clocks) */
    lld_lcdWriteReg(LCD_PANEL_INTERFACE_CONTROL5_R97, 0x0110); /* Set Gate Non-overlap Period 0 locksc */
    lld_lcdWriteReg(LCD_PANEL_INTERFACE_CONTROL6_R98, 0x0110);
    lld_lcdWriteReg(LCD_DISPLAY_CONTROL1_R07, 0x0173); /* Display On */

	/* Turn on the backlight */
	gdisp_lld_backlight(GDISP_INITIAL_BACKLIGHT);
	
    /* Initialise the GDISP structure */
    GDISP.Width = GDISP_SCREEN_WIDTH;
    GDISP.Height = GDISP_SCREEN_HEIGHT;
    GDISP.Orientation = GDISP_ROTATE_0;
    /* GDISP.Powermode = powerOn; */
    GDISP.Backlight = GDISP_INITIAL_BACKLIGHT;
    GDISP.Contrast = GDISP_INITIAL_CONTRAST;
    #if GDISP_NEED_VALIDATION || GDISP_NEED_CLIP
	GDISP.clipx0 = 0;
	GDISP.clipy0 = 0;
	GDISP.clipx1 = GDISP.Width;
	GDISP.clipy1 = GDISP.Height;
    #endif

	return TRUE;
}

static void lld_lcdSetCursor(uint16_t x, uint16_t y)
{

	switch(GDISP.Orientation) {
		case GDISP_ROTATE_0:
			lld_lcdWriteReg(LCD_GRAM_HORIZONTAL_R20, x);
			lld_lcdWriteReg(LCD_VERTICAL_ADDRESS_SET_R21, y);
			break;

		case GDISP_ROTATE_90:
			lld_lcdWriteReg(LCD_GRAM_HORIZONTAL_R20, y);
			lld_lcdWriteReg(LCD_VERTICAL_ADDRESS_SET_R21, x);
			break;

		case GDISP_ROTATE_180:
			lld_lcdWriteReg(LCD_GRAM_HORIZONTAL_R20, x);
			lld_lcdWriteReg(LCD_VERTICAL_ADDRESS_SET_R21, y);
			break;

		case GDISP_ROTATE_270:
			lld_lcdWriteReg(LCD_GRAM_HORIZONTAL_R20, y);
			lld_lcdWriteReg(LCD_VERTICAL_ADDRESS_SET_R21, x);
			break;
	}
}

void lld_lcdSetViewPort(uint16_t x, uint16_t y, uint16_t cx, uint16_t cy)
{
	switch(GDISP.Orientation) {
		case GDISP_ROTATE_0:
			lld_lcdWriteReg(LCD_HORIZONTAL_GRAM_STRART_R50, x);
			lld_lcdWriteReg(LCD_HORIZONTAL_GRAM_END_R51, x + cx - 1);
			lld_lcdWriteReg(LCD_VERTICAL_GRAM_STRART_R52, y);
			lld_lcdWriteReg(LCD_VERTICAL_GRAM_END_R53, y + cy - 1);
			break;

		case GDISP_ROTATE_90:
			lld_lcdWriteReg(LCD_HORIZONTAL_GRAM_STRART_R50, y);
			lld_lcdWriteReg(LCD_HORIZONTAL_GRAM_END_R51, y + cy - 1);
			lld_lcdWriteReg(LCD_VERTICAL_GRAM_STRART_R52, x);
			lld_lcdWriteReg(LCD_VERTICAL_GRAM_END_R53, x + cx - 1);
			break;

		case GDISP_ROTATE_180:
			lld_lcdWriteReg(LCD_HORIZONTAL_GRAM_STRART_R50, x);
			lld_lcdWriteReg(LCD_HORIZONTAL_GRAM_END_R51, x + cx - 1);
			lld_lcdWriteReg(LCD_VERTICAL_GRAM_STRART_R52, y);
			lld_lcdWriteReg(LCD_VERTICAL_GRAM_END_R53, y + cy - 1);
			break;

		case GDISP_ROTATE_270:
			lld_lcdWriteReg(LCD_HORIZONTAL_GRAM_STRART_R50, y);
			lld_lcdWriteReg(LCD_HORIZONTAL_GRAM_END_R51, y + cy - 1);
			lld_lcdWriteReg(LCD_VERTICAL_GRAM_STRART_R52, x);
			lld_lcdWriteReg(LCD_VERTICAL_GRAM_END_R53, x + cx - 1);
			break;
	}

	lld_lcdSetCursor(x, y);
}

static void lld_lcdResetViewPort(void)
{
    switch(GDISP.Orientation) {
        case GDISP_ROTATE_0:
        case GDISP_ROTATE_180:
            lld_lcdSetViewPort(0, 0, GDISP_SCREEN_WIDTH, GDISP_SCREEN_HEIGHT);
            break;
        case GDISP_ROTATE_90:
        case GDISP_ROTATE_270:
           	lld_lcdSetViewPort(0, 0, GDISP_SCREEN_HEIGHT, GDISP_SCREEN_WIDTH);
            break;
    }
}

void gdisp_lld_draw_pixel(uint16_t x, uint16_t y, uint16_t color)
{
    #if GDISP_NEED_VALIDATION || GDISP_NEED_CLIP
        if (x < GDISP.clipx0 || y < GDISP.clipy0 || x >= GDISP.clipx1 || y >= GDISP.clipy1) return;
    #endif
    lld_lcdSetCursor(x, y);
    lld_lcdWriteReg(LCD_WRITE_DATA_TO_GRAM_R22, color);
}

#if GDISP_HARDWARE_CLEARS
	void gdisp_lld_clear(uint16_t color)
	{
	    unsigned i;

	    lld_lcdSetCursor(0, 0);
	    lld_lcdWriteStreamStart();
	    for(i = 0; i < GDISP_SCREEN_WIDTH * GDISP_SCREEN_HEIGHT; i++)
	    	lld_lcdWriteData(color);

	    lld_lcdWriteStreamStop();
	}
#endif

#if GDISP_HARDWARE_FILLS || defined(__DOXYGEN__)
	void gdisp_lld_fill_area(coord_t x, coord_t y, coord_t cx, coord_t cy, color_t color) {
		#if GDISP_NEED_VALIDATION || GDISP_NEED_CLIP
			if (x < GDISP.clipx0) { cx -= GDISP.clipx0 - x; x = GDISP.clipx0; }
			if (y < GDISP.clipy0) { cy -= GDISP.clipy0 - y; y = GDISP.clipy0; }
			if (cx <= 0 || cy <= 0 || x >= GDISP.clipx1 || y >= GDISP.clipy1) return;
			if (x+cx > GDISP.clipx1)	cx = GDISP.clipx1 - x;
			if (y+cy > GDISP.clipy1)	cy = GDISP.clipy1 - y;
		#endif

		unsigned i, area;

		area = cx*cy;
		lld_lcdSetViewPort(x, y, cx, cy);
		lld_lcdWriteStreamStart();
		for(i = 0; i < area; i++)
			lld_lcdWriteData(color);
		lld_lcdWriteStreamStop();
		lld_lcdResetViewPort();
	}
#endif

#if GDISP_HARDWARE_BITFILLS || defined(__DOXYGEN__)
	void gdisp_lld_blit_area_ex(coord_t x, coord_t y, coord_t cx, coord_t cy, coord_t srcx, coord_t srcy, coord_t srccx, const pixel_t *buffer) {
		coord_t endx, endy;
		unsigned lg;

		#if GDISP_NEED_VALIDATION || GDISP_NEED_CLIP
			if (x < GDISP.clipx0) { cx -= GDISP.clipx0 - x; srcx += GDISP.clipx0 - x; x = GDISP.clipx0; }
			if (y < GDISP.clipy0) { cy -= GDISP.clipy0 - y; srcy += GDISP.clipy0 - y; y = GDISP.clipy0; }
			if (srcx+cx > srccx)		cx = srccx - srcx;
			if (cx <= 0 || cy <= 0 || x >= GDISP.clipx1 || y >= GDISP.clipy1) return;
			if (x+cx > GDISP.clipx1)	cx = GDISP.clipx1 - x;
			if (y+cy > GDISP.clipy1)	cy = GDISP.clipy1 - y;
		#endif

		lld_lcdSetViewPort(x, y, cx, cy);
		lld_lcdWriteStreamStart();

		endx = srcx + cx;
		endy = y + cy;
		lg = srccx - cx;
		buffer += srcx + srcy * srccx;
		for(; y < endy; y++, buffer += lg)
			for(x=srcx; x < endx; x++)
				lld_lcdWriteData(*buffer++);
		lld_lcdWriteStreamStop();
		lld_lcdResetViewPort();
	}
#endif

#if (GDISP_NEED_PIXELREAD && GDISP_HARDWARE_PIXELREAD) || defined(__DOXYGEN__)
	color_t gdisp_lld_get_pixel_color(coord_t x, coord_t y) {
		color_t color;

		#if GDISP_NEED_VALIDATION || GDISP_NEED_CLIP
			if (x < 0 || x >= GDISP.Width || y < 0 || y >= GDISP.Height) return 0;
		#endif

		lld_lcdSetCursor(x, y);
		lld_lcdWriteStreamStart();

		color = lld_lcdReadData();
		color = lld_lcdReadData();

		lld_lcdWriteStreamStop();

		return color;
	}
#endif

#if (GDISP_NEED_SCROLL && GDISP_HARDWARE_SCROLL) || defined(__DOXYGEN__)
	void gdisp_lld_vertical_scroll(coord_t x, coord_t y, coord_t cx, coord_t cy, int lines, color_t bgcolor) {
		static color_t buf[((GDISP_SCREEN_HEIGHT > GDISP_SCREEN_WIDTH ) ? GDISP_SCREEN_HEIGHT : GDISP_SCREEN_WIDTH)];
		coord_t row0, row1;
		unsigned i, gap, abslines;

		#if GDISP_NEED_VALIDATION || GDISP_NEED_CLIP
			if (x < GDISP.clipx0) { cx -= GDISP.clipx0 - x; x = GDISP.clipx0; }
			if (y < GDISP.clipy0) { cy -= GDISP.clipy0 - y; y = GDISP.clipy0; }
			if (!lines || cx <= 0 || cy <= 0 || x >= GDISP.clipx1 || y >= GDISP.clipy1) return;
			if (x+cx > GDISP.clipx1)	cx = GDISP.clipx1 - x;
			if (y+cy > GDISP.clipy1)	cy = GDISP.clipy1 - y;
		#endif

		abslines = lines < 0 ? -lines : lines;

		if (abslines >= cy) {
			abslines = cy;
			gap = 0;
		} else {
			gap = cy - abslines;
			for(i = 0; i < gap; i++) {
				if(lines > 0) {
					row0 = y + i + lines;
					row1 = y + i;
				} else {
					row0 = (y - i - 1) + lines;
					row1 = (y - i - 1);
				}

				/* read row0 into the buffer and then write at row1*/
				lld_lcdSetViewPort(x, row0, cx, 1);
				lld_lcdReadStreamStart();
				lld_lcdReadStream(buf, cx);
				lld_lcdReadStreamStop();

				lld_lcdSetViewPort(x, row1, cx, 1);
				lld_lcdWriteStreamStart();
				lld_lcdWriteStream(buf, cx);
				lld_lcdWriteStreamStop();
			}
		}

		/* fill the remaining gap */
		lld_lcdSetViewPort(x, lines > 0 ? (y+gap) : y, cx, abslines);
		lld_lcdWriteStreamStart();
		gap = cx*abslines;
		for(i = 0; i < gap; i++) lld_lcdWriteData(bgcolor);
		lld_lcdWriteStreamStop();
		lld_lcdResetViewPort();
	}
#endif

#if (GDISP_NEED_CONTROL && GDISP_HARDWARE_CONTROL) || defined(__DOXYGEN__)
	void gdisp_lld_control(unsigned what, void *value) {
		switch(what) {
			case GDISP_CONTROL_POWER:
				if(GDISP.Powermode == (gdisp_powermode_t)value)
					return;
				switch((gdisp_powermode_t)value) {
					case powerOff:
						acquire_bus();
						lld_lcdWriteReg(0x0007, 0x0000);
						lld_lcdWriteReg(0x0010, 0x0000);
						lld_lcdWriteReg(0x0011, 0x0000);
						lld_lcdWriteReg(0x0012, 0x0000);
						lld_lcdWriteReg(0x0013, 0x0000);
						release_bus();

						gdisp_lld_backlight(0);
						break;
			
					case powerOn:
						//*************Power On sequence ******************//
						acquire_bus();
						lld_lcdWriteReg(0x0010, 0x0000); /* SAP, BT[3:0], AP, DSTB, SLP, STB */
						lld_lcdWriteReg(0x0011, 0x0000); /* DC1[2:0], DC0[2:0], VC[2:0] */
						lld_lcdWriteReg(0x0012, 0x0000); /* VREG1OUT voltage */
						lld_lcdWriteReg(0x0013, 0x0000); /* VDV[4:0] for VCOM amplitude */
						lld_lcdDelay(4000);            /* Dis-charge capacitor power voltage */
						lld_lcdWriteReg(0x0010, 0x17B0); /* SAP, BT[3:0], AP, DSTB, SLP, STB */
						lld_lcdWriteReg(0x0011, 0x0147); /* DC1[2:0], DC0[2:0], VC[2:0] */
						lld_lcdDelay(1000);
						lld_lcdWriteReg(0x0012, 0x013C); /* VREG1OUT voltage */
						lld_lcdDelay(1000);
						lld_lcdWriteReg(0x0013, 0x0E00); /* VDV[4:0] for VCOM amplitude */
						lld_lcdWriteReg(0x0029, 0x0009); /* VCM[4:0] for VCOMH */
						lld_lcdDelay(1000);
						lld_lcdWriteReg(0x0007, 0x0173); /* 262K color and display ON */
						release_bus();

						gdisp_lld_backlight(GDISP.Backlight);
						if(GDISP.Powermode != powerSleep || GDISP.Powermode != powerDeepSleep)
							gdisp_lld_init();
						break;
	
					case powerSleep:
						acquire_bus();
	             		lld_lcdWriteReg(0x0007, 0x0000); /* display OFF */
	                   	lld_lcdWriteReg(0x0010, 0x0000); /* SAP, BT[3:0], APE, AP, DSTB, SLP */
	                  	lld_lcdWriteReg(0x0011, 0x0000); /* DC1[2:0], DC0[2:0], VC[2:0] */
	                  	lld_lcdWriteReg(0x0012, 0x0000); /* VREG1OUT voltage */
	                  	lld_lcdWriteReg(0x0013, 0x0000); /* VDV[4:0] for VCOM amplitude */
	                  	lld_lcdDelay(4000); /* Dis-charge capacitor power voltage */
	                   	lld_lcdWriteReg(0x0010, 0x0002); /* SAP, BT[3:0], APE, AP, DSTB, SLP */				
						release_bus();

						gdisp_lld_backlight(0);
						break;

					case powerDeepSleep:
						acquire_bus();
					    lld_lcdWriteReg(0x0007, 0x0000); /* display OFF */
					    lld_lcdWriteReg(0x0010, 0x0000); /* SAP, BT[3:0], APE, AP, DSTB, SLP */
					    lld_lcdWriteReg(0x0011, 0x0000); /* DC1[2:0], DC0[2:0], VC[2:0] */
	   					lld_lcdWriteReg(0x0012, 0x0000); /* VREG1OUT voltage */
	   					lld_lcdWriteReg(0x0013, 0x0000); /* VDV[4:0] for VCOM amplitude */
	   					lld_lcdDelay(4000); /* Dis-charge capacitor power voltage */
	  					lld_lcdWriteReg(0x0010, 0x0004); /* SAP, BT[3:0], APE, AP, DSTB, SLP */
	  					release_bus();

						gdisp_lld_backlight(0);
						break;

					default:
						return;
				}
				GDISP.Powermode = (gdisp_powermode_t)value;
				return;

			case GDISP_CONTROL_ORIENTATION:
				if(GDISP.Orientation == (gdisp_orientation_t)value)
					return;
				switch((gdisp_orientation_t)value) {
					case GDISP_ROTATE_0:
						acquire_bus();
						lld_lcdWriteReg(0x0001, 0x0100);
						lld_lcdWriteReg(0x0003, 0x1038);
						lld_lcdWriteReg(0x0060, 0x2700);
						release_bus();

						GDISP.Height = GDISP_SCREEN_HEIGHT;
						GDISP.Width = GDISP_SCREEN_WIDTH;
						break;

					case GDISP_ROTATE_90:
						acquire_bus();
						lld_lcdWriteReg(0x0001, 0x0100);
						lld_lcdWriteReg(0x0003, 0x1030);
						lld_lcdWriteReg(0x0060, 0x2700);
						release_bus();

						GDISP.Height = GDISP_SCREEN_WIDTH;
						GDISP.Width = GDISP_SCREEN_HEIGHT;
						break;
			
					case GDISP_ROTATE_180:
						acquire_bus();
						lld_lcdWriteReg(0x0001, 0x0000);
						lld_lcdWriteReg(0x0003, 0x1030);
						lld_lcdWriteReg(0x0060, 0x2700);
						release_bus();

						GDISP.Height = GDISP_SCREEN_HEIGHT;
						GDISP.Width = GDISP_SCREEN_WIDTH;
						break;
		
					case GDISP_ROTATE_270:
						acquire_bus();
						lld_lcdWriteReg(0x0001, 0x0000);
						lld_lcdWriteReg(0x0003, 0x1038);
						lld_lcdWriteReg(0x0060, 0xA700);
						release_bus();

						GDISP.Height = GDISP_SCREEN_WIDTH;
						GDISP.Width = GDISP_SCREEN_HEIGHT;
						break;
			
					default:
						return;
				}
			
				#if GDISP_NEED_CLIP || GDISP_NEED_VALIDATION
				GDISP.clipx0 = 0;
				GDISP.clipy0 = 0;
				GDISP.clipx1 = GDISP.Width;
				GDISP.clipy1 = GDISP.Height;
				#endif
				GDISP.Orientation = (gdisp_orientation_t)value;
				return;

			case GDISP_CONTROL_BACKLIGHT:
				if((unsigned)value > 100) value = (void *)100;
				gdisp_lld_backlight((unsigned)value);
				GDISP.Backlight = (unsigned)value;
				break;
			
			default:
				return;
		}
	}

#endif
/** @} */
